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ABSTRACT 

Many of the operations performed at Kennedy Space Center (KSC) are 
dangerous and repetitive tasks which make them ideal candidates for robotic 
applications. For One specific application, KSC is currently in the process 
of designing and constructing a robot, called the Automated Radiator 
Inspection Device (ARID), to inspect the radiator panels on the orbiter. In 
this report, the following related aspects of the ARID project are discussed: 
1) Modeling of the ARID, 2) Design of control algorithms for the ARID, and 3) 
Nonlinear- Based simulation of ARID control algorithms. Based on the 
information delineated in this report, recommendations are then made to 
assist KSC personnel in the successful completion of the ARID project. 
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Siunary 

To automate the inspection of fhe radiator panels on the orbiter, Kennedy 
Space Center (KSC) is designing and constructing the Automated Radiator 
Inspection Device (ARID). Utilizing a vision- based system, the ARID will be 
capable of inspecting the entire surface of the radiator panels. Due to 
accuracy requirements imposed by the vision system, the ARID robot must be 
precisely controlled to ensure that the end- effector mounted camera is 
maintained at the proper distance from the radiator panels. To aid KSC 
personnel in the successful completion of the ARID project, a study was done 
to examine the associated modeling and control aspects of the ARID robot. 

With regard to modeling, several separate sub- areas are analyzed and 
investigated. The rigid body statics and dynamics are formulated to describe 
the geometry and dynamic motion of the ARID. Since the ARID is a large robot 
that utilizes harmonic drives, a model including the effects of dominant mode 
structural vibrations and joint flexibilities are incorporated into the 
rigid- body dynamics. Since the ARID utilizes a redundant actuation system, a 
model including redundant actuators is also formulated. 

With regard to control, several separate sub- areas are analyzed and 
investigated. For the rigid- body model, the performance of a PD controller 
is compared to a robust saturation controller. For the inclusion of joint 
flexibilities and dominant mode vibrational effects into the rigid body 
dynamics, the performance of a PD motor controller is compared to a nested PD 
motor/link controller and a nested PD motor/link/tip controller. To 
investigate the effects of redundant actuation on the control system 
performance, an independent torque controller is compared to a coupled torque 
controller. 



5 


TABLE OF CONTENTS 


Section Title 

I. INTRODUCTION 

1.1 Robotics at Kennedy Space Center 

1.2 Description of the Automated Radiator Inspection Device 

1.3 Objective of this Research Project 

II. RIGID BODY STATICS AND DYNAMICS 

2.1 Kinematics 

2.2 Inverse Kinematics 

2.3 Manipulator Jacobian 

2.4 Manipulator Dynamics 

III. SIMULATION OF CONTROLLERS FOR THE RIGID BODY DYNAMICS 

3.1 PD Control 

3.2 Robust Saturation Control 

IV. MODELING AND CONTROL FOR JOINT FLEXIBILITIES 

4.1 Model of Joint Flexibilities 

4.2 PD Motor Control and Simulation 

4.3 Nested PD Motor/Link Control and Simulation 

V. MODELING AND CONTROL FOR VIBRATIONAL EFFECTS 

5.1 Model of Dominant Vibrations 

5.2 PD Motor Control and Simulation 

5.3 Nested PD Motor/Link/Tip Control and Simulation 

VI. SYNCHRONIZATION OF REDUNDANT MOTORS 

6.1 Model of Motor Synchronization Problem 

6.2 Independent Torque Control and Simulation 

6.3 Coupled Torque Control and Simulation * 

VII. CONCLUSIONS AND RECOMMENDATIONS 

7.1 Conclusions 

7.2 Recommendations 

VIII. FIGURES 

IX. REFERENCES 


145 



6 


LIST OF ILLUSTRATIONS 


Figure 

Title 

1.1 

Diagram of the ARID Robot 

2.1 

3- Link Robot Freebody Diagram 

3.1 

Rigid- Link PD Control Simulation 

3.2 

Rigid- Link Robust Saturation Control Simulation 

4.1 

Model of Joint Flexibilities 

4.2 

PD Motor Control Simulation 

4.3 

Nested PD Motor/Link Control Simulation 

5.1 

Model of Dominant Vibrations 

5.2 

PD Motor Control Simulation 

5.3 

Nested PD Motor/Link/Tip Control Simulation 

6.1 

Motor Synchronization Model 

6.2 

Independent Torque Control Simulation 

6.3 

Coupled Torque Control Simulation 


146 



7 


I. INTRODUCTION 

1.1 Robotics at Kennedy Space Center 

The mission of Kennedy Space Center (KSC) is to provide manpower and 
support for fast, efficient, and safe preparation of launch vehicles. 
Robotics can be a key ingredient to satisfy this mission. Many of the 
operations performed at KSC are dangerous and repetitive which make them 
ideal candidates for robotic applications. The design and servicing 
procedures of present space vehicles and launch procedures make it difficult 
to implement robotic applications; however, the next generation space 
vehicles will no doubt be designed with robots in mind. Therefore, KSC 
personnel will have to become increasingly familiar with robots and related 
hardware such as sensors and control systems. The Robotics Applications 
Development Laboratory (RADL) provides this experience to KSC personnel and 
its contractors. 

1.2 Description of the Automated Radiator Inspection Device 

KSC is currently in the process of designing and constructing a robot, 
called the Automated Radiator Inspection Device (ARID) , to inspect the 
radiator panels on the orbiter (See Figure 1.1). These panels, located on 
the inside of the cargo bay doors, are inspected when the orbiter is 
horizontally parked in the Orbiter Processing Facility (OPF) . After the 
Cargo bay doors are opened to expose the radiator panels, the inspection is 
presently performed by workers in a crane- assisted bucket over the radiator 
surface. The radiator surface is divided into grids, and surface defects are 
cataloged by location in the grid. These surface defects are monitored 
periodically to determine when repair is needed. 

To automate this inspection process, the ARID robot is being constructed 
to move along the orbiter on a long track. Utilizing a vision-based system, 
the ARID will be capable of inspecting the entire surface of the radiator 
panels. The associated vision system will be able to divide the radiator 
panels into smaller grids and thus provide better cataloging of defects. 

1.3 Objective of this Research Project 

The objective of this research project is to assist KSC personnel in 
three areas: 1) Modeling of the ARID, 2) Design of control algorithms for 
the ARID, and 3) Nonlinear- based simulation of ARID control algorithms. The 
body of this report is dividing among these three areas. 

With regard to modeling, several separate sub- areas are analyzed and 
investigated. The rigid body statics and dynamics [1] are formulated to 
describe the geometry and dynamic motion of the ARID. Specifically, the ARID 
kinematics, inverse kinematics, manipulator jacobian, and manipulator 
dynamics are given. Since the ARID utilizes harmonic drives, a model 
including effects of joint flexibilities [2] is incorporated into the 
rigid- body dynamics. Because of the large size of the ARID, structural 
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vibrations [3] are considered to be a potential problem; therefore, a model 
including the effects of "dominate mode" vibrations are incorporated into the 
rigid body/flexible joint model. Since the ARID utilizes a redundant 
actuation system, motor synchronization is considered to be a potential 
problem; therefore, a model including the effects of redundant actuators is 
formulated. 


With regard to control, several separate sub- areas are analyzed and 
investigated. A proportional- derivative (PD) controller [1] and a robust 
saturation controller [4] are both designed for the rigid- body dynamics. For 
the inclusion of joint flexibilities into the rigid body dynamics, a PD motor 


are formulated. For 
T>ody/joint flexibility 


controller [1] and nested PD motor/link controller [5] 
the inclusion of vibrational effects into the rigid 1 
model, a PD motor controller [1] and nested PD motor/link/tip controller [6] 
are formulated. To study the effects of redundant actuation on the control 
system performance, an independent torque controller [7] and a coupled torque 
controller [7] are formulated. 


With regard to simulation, several separate sub- areas are analyzed and 
investigated. For the rigid- body model, the performance of a PD controller 
is compared to a robust saturation controller. For the inclusion of joint 
flexibilities into the rigid body dynamics, the performance of a PD motor 
controller is compared to a nested PD motor/link controller. For the 
inclusion of vibrational effects into the rigid body/joint flexibility model, 
the performance of a PD motor controller is compared to a nested PD 
motor/link/tip controller. To investigate the effects of redundant actuation 
on the control system performance, an independent torque controller is 
compared to a coupled torque controller. 

II. RIGID BODY STATICS AND DYNAMICS 

In this section, we present the static and dynamic rigid body 
relationships for the ARID robot. The terminology rigid body is used to 
emphasize that flexibilities due to link and drive transmissions have been 
neglected. In subsequent subsections, we will discuss modifications of the 
dynamic model due to link and joint flexibilities. 

From Figure 1.1, we can see that the prismatic joint moves perpendicular 
to the direction of the three revolute joints; therefore, the motion of the 
prismatic joint is decoupled from the motion of the revolute joints. Since 
the prismatic motion is decoupled from the motion of the revolute joints, the 
static and dynamic relationships for the prismatic joint are relatively 
simple; therefore, in this section, we will only discuss the static and 
dynamic relationships for the revolute joints. Specifically, we will present 
the kinematics, inverse kinematics, manipulator jacobian, and the manipulator 
dynamic relationships for the three revolute joints. 

2.1 Kinematics 


The kinematics [1] (i.e. forward kinematics) problem is associated with 
finding the end- effector position and orientation given the three joint 
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angles. The end- effector position and orientation is sometimes called the 
task space coordinate set. From the geometric description given in Figure 
2 . 1 , we define the task space coordinate set as 



( 2 . 1 ) 


where X is a 3x1 vector, x denotes the position of the end- effector in the 
x- direction, y denotes the position of the end- effector in y- direction, and 6 
denotes the end- effector angle of orientation measured off the x-axis. Nete 
that the coordinate set {x,y} defined in Figure 2.1 is a non- rotating 
coordinate set . 


Utilizing a geometric approach, it is easy to show that the relationships 
between the task space variables and the joint space variables are given by 





L 3 c 123 + L 2 C 12 + L l c l 

X = 

t 

= h(q) = 

L 3 s 123 + L 2 s 12 + L 1 S 1 

.Ql + q 2 + 


( 2 . 2 ) 


where q^, q 2 , q^ are the joint variables defined in Figure 2.1; h(q) is the 
3x1 vector of kinematic functions; L^, L 2 , Lg are the link lengths defined in 
Figure 2.1; and Cp s 12 , c 123 are used as abbreviations for cos(q 1 ), 
sin(q 1 + q 2 ) , and cos(q 1 + q 2 + < 13)5 respectively. 


2.2 Inverse Kinematics 


The inverse kinematics [ 1 ] problem is associated with finding the three 
joint angles given the end- effector position and orientation. From the 
geometric description given in Figure 2.1, we define the joint space variable 
set as 



(2.3) 


where q is a 3x1 vector composed of the joint variables. 

Utilizing a geometric approach, it is easy to show that the relationship 
between the joint space variables and the task space variables are given by 


<*1 


= Atan2 


y - h s e 


(x - L3C0) 2 + (y - Ljs/ + l\ - L 2 * 

x ■ Vo. 

' nk-UD 

2 Lj (x - LgC^) 2 + (y - l 3 s^) 2 


(2.4) 
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and 


q2 = Atan2 


C t y - S t X - LgCCjS^ - SjC^) 

V + \y - L 3 ( c i s 0 + s i s ^) - L i 


J 


(2.5) 


q 3 = t - qj - q 2 ( 2 - 6 ) 

where Acos(.) is used to denote the inverse cosine operation, Atan2(.) is 
used to denote the inverse tangent operation with quadrant checking 
operation, and the positive/negative operation (i.e. ± in (2.4)) is used to 
specify the up/down configuration of the ARID elbow. 

2.3 Manipulator Jacobian 

The manipulator jacobian matrix [1] is used to relate the joint space 
velocity vector to the task space velocity vector. The jacobian matrix is 
obtained by taking the time derivative of the forward kinematics given in 
(2.2). That is, the 3x3 Jacobian matrix (i.e. J(q)) satisfies the 
relationship 


X = 

X 


*i 

y 

= J(q)q = J(q) 

^2 


X 


Lq 3 J 


where 


J(q) 


' L l s l 

L l c l 


L 2 s 12 ' L 3 S 123 
+ L 2 c 12 + L 3 c 123 

1 


(2.7) 


~ L 2 s 12 ' L 3 s 123 

L 2 C 12 + L 3 C 123 
1 


L 3 S 123 

L 3 C 123 • 
1 


(2.8) 


One of the advantages of calculating the jacobian matrix online is that 
it can be used to avoid online calculation of the inverse kinematics. For 
example, one can utilize the task- space PD control [1] 


T = J T (q) K v (i d - J(q)q) + K p (x d - h(q)) 


(2.9) 


where K y , K p are positive definite 3x3 gain matrices, x^ is a 3x1 vector used 

to represent the desired task space trajectory that we wish to track, and r 
is the 3x1 vector used to represent the input torque to each link. 


Note that (2.9) does not depend on the calculation of the inverse 
kinematics. It should also be noted that the task space coordinate set 
defined in this report is a nonrotating coordinate frame. For actual 
implementation of the ARID robot, a task space formulation can be used that 
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ensures that the ARID camera is always perpendicular to the radiator surface. 
This task- space coordinate set can be formulated if an analytical function of 
the radiator surface can be obtained. 

2.4 Manipulator Dynaaics 

A robot is basically a positioning device. To control the end effector 
position we must know the dynamic properties of the manipulator in order to 
know how much force to exert on it to cause it to move. Too little force and 
the manipulator is slow to react. Too much force and the manipulator may 
oscillate about the desired position. 

In this section, we give the dynamics of the ARID robot in the Lagrange 
Euler form [1] . The rigid body dynamics for the 3- link revolute ARID robot 
arm are 


t = M(q)q + V(q,q) + G(q) + F(q) 


( 2 . 10 ) 


where M(q) is a 3x3 link inertia matrix, V(q,q) is a 3x1 vector containing 
the centripetal and Coriolis terms, G(q) is a 3x1 vector containing the 

gravity terms, F(q) is a 3x1 vector containing the static and dynamic 

friction terms, q is a 3x1 vector representing the link accelerations, and r 
is the 3x1 control vector used to represent the torque provided by the 
actuators in each joint. With regard to ARID robot, we now explicitly define 
each term associated with (2.10). First, the inertia matrix M(q) is given by 




[ M n 

»12 

M 13 


M(q) = 

*21 

M 22 

M 23 



*31 

M 32 

M 33 

where 





*n 

- mjL^ + m 2 (L 2 

+ l c2 

.+ 2L.L 

1 i 


, t 2 T 2 
+ mg(L^ + 

+ L c3 4 

2L 1 L 2 ( 

*12 

= M 21 = m 2 (L 2 2 

+ L 1 L c2 

,e 2 ) + 


/t 2 
+ m 3 (L 2 

*4 

+ l 1 l 2 , 

*13 

= M 31 = I 3 + m 3 

( L c3 + 

l i l c 3 c : 


( 2 . 11 ) 


M, 


22 


“ m 2 L c2 


+ In + Ir 


+ lHo (Lr> + L 


2 

"2 


2 

c3 


2L 2 L c3 c 3^ ’ 
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^23 - %2 - ^3 + + 5 


3 V c3 T 2 c3 3' 


M 33 “ m 3 L c3 + X 3’ 

Ip I 2 j Ig, are the moments of inertia of links Lp L 2 , Lg, respectively; 
L ci , L c2 , L c3 , are the distances to the center of mass of links Lp L 2 , Lg, 
respectively; and m^, m 2 , mg, are the masses of links Lp L 2 , Lg, 

respectively (See Figure 2.1). Second, the Coriolis/centripetal terms V(q,q) 
are given by 


V(q,q) = 


'1 


( 2 . 12 ) 


where 


V l = (“ m 2 L l L c2 " m 3^ L l L 2 s 2 + L l L c3 s 23^2 + ^' m 3^ L l L c3 s 23 + L 2 L c3 s 3^^3 
+ (-m 2 L 1 L c2 - m 3 (L 1 L 2 s 2 + 

+ 2 (- m 3 ( L 1 L c gS 2 g + L 2 L c 3 s 3))(%^2 + ^ 3 )* 

V 2 = ( m 2 L l L c2 + m 3^ L l L 2 s 2 + L l L c3 S 23^1 + (' m 3 L 2 L c3 S 3^3 


+ 2(-m 3 L 2 L c3 s 3 )(q 1 q 2 + q 2 q 3 ) 


and 


V 3 - (m 3 (L 1 L c3 s 23 + L 2 L c3 s 3 ))q^ + ( m 3 L 2 L C 3 s 3^2 + 2 ( m 3 L 2 L c3 s 3^1^2' 
Third, the gravity terms G(q) are given by 

G(q) = 


where 


(2.13) 


G 1 ra l6 L cl c l + ra 2 s ^l c l + L c2 c 12^ + m 3 S( L i c i + L 2 C 12 + L c3 C 123^ » 


152 


13 


S ~ m 2 sL c2 c 12 + m 3 s ^ L 2 c 12 + L c3 c 123^’ 

G 3 = m 3 sL c3 c 123 5 
and 

2 

g is used to denote the gravitational constant (i.e. 9.81 m/s ). Lastly, the 
friction terms F(q) are given by 



(2.14) 


where 

F 1 = v f A + k fl s E"( ( i 1 ) ■ 

F 2 = v f2^2 + k f2 s S n A)’ 

F 3 = v f3«3 + k f3 S S n A 3 ) . 


Vfl, k^ are positive scalar constants used to denote the static and dynamic 

coefficients of friction for joint 1; v^? k ^ ^ are positive scalar constants 

used to denote the static and dynamic coefficients of friction for joint 2; 
v f3’ kf 3 are positive scalar constants used to denote the static and dynamic 

coefficients of friction for joint 3; and the sgn(.) is used to represent the 
signum function. 

III. SIMULATION OF CONTROLLERS FOR THE RIGID BODY DYNAMICS 

Utilizing the rigid body dynamics developed in Section II, controllers 
can be developed and tested. Specifically, the dynamic in (2.10) can be 
rewritten in the form 


q = M _1 (q) [r - V(q,q) - G(q) - F(q)] . (3.1) 

Utilizing a integration package such as SIMNON, the dynamics given by (3.1) 
can now be integrated over any desired simulation interval for any postulated 
control input r. 

Typically, the robot control objective is formulated as the tracking 
problem. That is, we wish to follow a desired trajectory for each joint with 
as small as deviation possible. To quantify the measure of success, we often 
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examine the tracking error which is defined by 

e = q d - q (3.2) 

where the 3x1 vector q^ is used to represent the desired trajectory for each 

joint. From (3.2), we can see that if tracking error (i.e. e) is small then 
we can be reasonably assured that the robot is performing as desired. 

3.1 PD Control 

As a starting point, we first simulated the simple PD controller [14] 
given by 


r = K y e + K p e (3.3) 

where K y , K p are 3x3 diagonal, positive definite matrices. The details of 

the program are given in the SIMNON file ARID1.T [8]. From Figure 3.1, we 
can see that the PD controller performs poorly, that is, the position and 
velocity tracking errors are relatively large. 

3.2 Robust Saturation Control 


To illustrate how an advanced control algorithm can improve tracking 
performance, we proposed the robust saturation controller [4] 


r = K y e + K p e + 


e + e 


(3.4) 


where e is a scalar positive constant, ||.|| is the standard Euclidean norm, 
and p is a scalar function that bounds the uncertainty. The details of the 
program are given in the SIMNON file ARID2.T [8]. From Figure 3.1 and 3.2, 
we can see that the robust saturation controller outperforms the PD 
controller by a wide margin. The reason for this improvement in performance 
is that the robust saturation controller compensates for any "uncertainty" 
with regard to the manipulator dynamics. 


IV. MODELING AND CONTROL FOR JOINT FLEXIBILITIES 



Since the ARID robot is a rather massive robot, the torque delivered to 
each link must be relatively large. To provide the necessary torque 
amplification, the ARID robot’s actuation system utilizes harmonic drives. 
While the harmonic drives amplify the torque by a factor of approximately 
200, the harmonic drives introduce flexibility at each joint. In order to 
move the robot accurately, the control strategy must compensate for the 
"joint flexibility" introduced by the harmonic drive. This very fact was 
confirmed in a presentation to KSC personnel by ROBOTICS RESEARCH INC. 
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4.1 Model of Joint Flexibilities 

The joint flexibilities introduced by the harmonic drives can be modeled 
by placing springs at each joint (See Figure 4.1). Similar to [2], the rigid 
body dynamics for the 3- link revolute ARID robot arm with joint flexibilities 
can then be shown to be 

*(q)4 ♦ V(q,q) + G(q) ♦ F(q) = K(rq m - q) (4.1) 

and 


+ Bq m + rK ( rq m ‘ q ) = r ( 4 - 2 ) 

where q m (t) is a 3x1 vector representing the actuator displacements, K is a 

constant diagonal 3x3 matrix used to denote the joint flexibilities, J is a 
3x3 positive- definite constant diagonal actuator inertia matrix, B is a 
positive- definite constant diagonal 3*3 matrix used to represent the actuator 
damping, T is a 3«3 positive- definite constant diagonal matrix used to 
represent the gear ratio in each harmonic drive, and all other quantities are 
the same as those defined in (2.10). 

4.2 FD Motor Control and Simulation 

To illustrate the pitfalls of local feedback (i.e. motor encoder feedback 
only) , we simulated a simple PD motor controller [1] given by 

t = ■ v + - <u (4-3) 

where K y , Kp are 3x3 diagonal, positive definite matrices. The details of 

the program are given in the SIMNON file ARID3.T [8]. From Figure 4.2, we 
can see that the PD controller performs poorly. The information delineated 
by Figure 4.2 makes sense since if we use motor feedback only, we not even 
attempting to control the robot end- effector (i.e. link position). That is, 
we are only controlling the motor. 

4.3 Nested PD lotor/Link Control and Simulation 

To illustrate the improvement in performance of including link encoder 
feedback along with motor encoder feedback, we simulated a nested PD 
motor/link controller [5] (i.e. nested feedback control means one feedback 
loop is inside another feedback loop) given by 

r = ‘mvVM + V - - 4)] - - 4) t 4 ' 4 ) 

where K y , Kp, K fflv , K are 3x3 diagonal, positive definite matrices, and K is 
the joint flexibility matrix defined in (4.1). The details of the program 
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are given in the SIMNON file ARID5.T [ 8 ]. From Figure 4.3, we can see that 
the nested PD motor/link controller performs very well. The information 
delineated by Figure 4.3 also makes sense since if we use link feedback, we 
are actually measuring the quantity that we attempting to control. Note that 
in addition to using the motor resolver for motor position information, we 
must mount a position encoder on each link to implement the controller given , 
in (4.4). 

V. MODELING AND CONTROL FOR VIBRATIONAL EFFECTS 

KSC personnel have often stated that the ARID will inspect the radiator 
panel along the prismatic joint axis [9] . That is, the gross motion of the 
ARID will be along the track while the revolute joints will move in small 
increments. Since the ARID is a long slender robot, it has been postulated 
that link vibrations along the prismatic joint axis may be a potential 
problem; therefore, the ARID control algorithm may have to be designed to 
actively compensate for these vibrations. Since these vibrations are the 
only ones considered in this report, we will refer to these gross motion 
vibrations as "dominant" vibrations. 

5.1 Model of Dominant Vibrations 

To compensate for the vibrations along the prismatic joint axis, a model 
for these vibrations must first be formulated. As shown in Figure 5.1, we 
have selected a lumped model [3] as a first attempt at proposing a possible ^ v 
solution to this problem. It should be emphasized that this problem of link 
flexibilities or link vibrations is still considered a research area. 

From Figure 5.1, the dominant vibration model including joint flexibility 
is given by 

Vi e + V’e • * M«e ' «L> = °- t 5 - 1 ) 

Vl + - 4 e ) + ' «e> = V™m - ( s - 2 ) 

and 

* b m«m + ’M™, • «l) = T (®- 3 ) 

where m e , m^, m m are positive scalar constants used to represent the lumped 

mass of the end- effector, link, and motor, respectively; b y , b ffl are positive 

scalar constants used to represent the lumped damping for the vibrational 
effects and the motor, respectively; q g , q^, q m are used to represent the 

position of the end- effector, link, and motor, respectively; k y , k m are 

positive scalar constants used to represent the lumped spring constant for 

the vibrational effects and the joint flexibilities, respectively; 7 is used ^ 
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to represent the gear ratio, and r is used to represent the control input. 

5.2 FD Motor Control and Simulation 

To illustrate the pitfalls of local feedback (i.e. motor encoder feedback 
only) , we simulated a simple PD motor controller [1] given by 

T = M’d - + V’d • ■«.) < 5 - 4 ) 

where K y , K p are 3x3 diagonal, positive definite matrices. The details of 

the program are given in the SIMNON file FLEX4.T [8]. From Figure 5,2, we 
can see that the PD controller performs very poorly. The information 
delineated by Figure 5.2 makes sense since if we use motor feedback only, we 
not even attempting to control the robot end- effector (i.e. end- effector 
position). That is, we are only controlling the motor. 

5.3 Nested PD Motor /Link/Tip Control and Simulation 

To illustrate the improvement in performance of including link encoder 
feedback and end- effector measurements along with motor encoder feedback, we 
simulated a nested PD motor/link/tip controller [6] given by 

t = vwy ; «l - 4 e )] * yyvv - K - « e >] < 5 - 5 > 

" K p3 K p2( q m ' " K p3( q m " 

where K p g, K^, K y j, K p , K p ^ are positive controller gains. The details of 

the program are given in the SIMNON file FLEX3.T [8]. From Figure 5.3, we 
can see that the nested PD motor/link/tip controller performs very well. The 
information delineated by Figure 5.3 also makes sense since if we use 
end- effector feedback, we are actually measuring the quantity that we are 
attempting to control. 

As we have already stated the controller given in (5.5) requires 
measurement of end- effector position as well as link and motor position; 
therefore, if vibrations become a problem, we must have a way of measuring 
end- effector position. A common method for measuring end- effector position 
for a vibrating robot is to mount an accelerometer on the end of the robot. 
The signal from the accelerometer can be integrated once to obtain 
end- effector velocity, that is 

M 1 ) = f Q dt + M 0 )* ( 5 - 6 ) 

The end- effector position can then be obtained by integrating (5.6) to obtain 
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q e (t) 



q e (t) dt + q e (0). 


(5.7) 


VI. SYNCHRONIZATION OF REDUNDANT MOTORS 

Since the ARID robot is the first robot to be installed next to flight 
hardware, the reliability of the ARID robot and associated control system is 
extremely important. That is, the ARID robot should be designed to minimize 
the chance of damaging the orbiter. To enhance reliability of the ARID 
robot, the electromechanical design of each joint includes redundant drive 
shafts, bearings, harmonic drives, brakes, transmission chains, motors, and 
computer control systems. 

As pointed out in [9] , two motors in parallel could cause a potential 
problem in that the motors might "fight" each other. That is, since the two 
motor/control systems will not have exactly the same dynamic characteristics, 
the torque delivered by each motor to the corresponding link will not be 
exactly the same at any instant of time. In this section, we develop a model 
and some control strategies to examine this motor synchronization problem. 

6.1 Model of Motor Synchronization Problem 

The model used to study the motor synchronization problem was based on 
the same model that was used to study the joint flexibility effects. For 
simplicity, we will only consider a one- link problem as illustrated in Figure 
6.1. From Figure 6.1, we can see that the model is composed of two motors 
connected to the same link. The associated dynamic equations for this system 
are given by 

mL 2 q + mgLsin(q) + v f q + k f sgn(q) = - q) + K 2 (r 2 q m2 - q) , (6.1) 

J lV + Mml + r i K l( r i q ml ' q ) = T V 

and 

J 2 q m2 + B 2 q m2 + r 2 K 2^2 q m2 ' q ) = T 2 ( 6 * 3 ) 

where q ffl j(t), q ffl2 (t) represent the actuator displacements of motors 1 and 2, 
respectively; Tp r 2 represent the torque delivered by motors 1 and 2, 
respectively; Kp K 2 are positive constants used to denote the joint 
flexibilities of harmonic drives 1 and 2, respectively; Jp J 2 are positive 
constants used to represent the inertia of motors 1 and 2, respectively; Bp 
B 2 are positive constants used to represent the damping in motors 1 and 2, 
respectively; Pp T 2 are positive constants used to represent the gear ratio 
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of harmonic drives 1 and 2, respectively; and all other quantities are the 
same as those defined in (4.1) and (4.2). 

6.2 Independent Torque Control and Simulation 

To simulate the effects of redundant motors, we first simulated the 
nested PD motor/link controller given in Section 4.3 for each redundant 
system. That is, each control system, designated control system 1 and 2, has 
no sensory input based on its counterpart’s performance. From Section 4.3, 
the two "independent" torque controllers are given by 

T 1 ' 'WW'vl 6 + V ' M«.l ’ 1)1 - K mvlVV - O < 6 - 4 > 

and 

t 2 = K mv2 K mp2 E K v2 6 + K p2 e ' K 2E q m2 ‘ q )E ' K mv2 K 2E q m2 ' q ) E 6 ' 5 ) 

where K yl , K pl , K nvl , K mpl , K y2 , K p2> K |nv2 , K mp2 are positive controller 
gains; K^, Kg are the joint flexibility constants defined in (6.1); and the 
link tracking error is defined in (3.2). 

To simulate a possible failure of control system 2, r 2 was set to zero at 

4 seconds. To simulate mismatch in the redundant systems, the parameters 
representing the two motors/drives were assumed to be mismatched by 507*. The 
details of the program are given in the SIMNON file SYC1.T [8]. From Figure 
6.2, we can see that the independent nested PD motor/link controllers perform 
very well. Even after motor 2 is shut completed down at 4 seconds, 
controller 1 compensates, for this failure. Figure 6.2 seems also to confirm 
that the motor fighting problem may not be a problem if a proper torque based 
controller is utilized. 

6.3 Coupled Torque Control and Simulation 

To simulate the effects of coupled control of redundant motors, we 
simulated a "coupled" nested PD motor/link controller similar to that given 
in Section 4.3. That is, each control system has sensory input based on its 
counterpart’s performance. The two coupled torque controllers are given by 

T 1 = t 2 = K n,v K mp[ |t v 4 + K p e * K ( q ml + q m2 ‘ 2q » ( 6 - 6 > 

' K mv K ( q ml + q m2 ‘ 2q ) 

where K y , K p , K mv , K mp are positive controller gains; and K is the average 
joint flexibility constant (i.e. (K^ + Kg)/2. 
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To simulate a possible failure of control system 2, t ^ was set to zero at 

4 seconds. To simulate mismatch in the redundant systems, the parameters 
representing the two motors/drives were assumed to be mismatched by 50% . The 
details of the program are given in the SIMNON file SYC2.T [8]. From Figure 
6.3, we can see that the coupled nested PD motor/link controllers perform 
very well. Even after motor 2 is shut completed down at 4 seconds, 
controller 1 compensates for this failure. Figure 6.3 seems also to confirm 
that the motor fighting problem may not be a problem if a proper torque based 
controller is utilized. 

It should be noted that the coupled torque control approach can be 
designed to maintain the redundant concept by installing redundant motor 
encoders at each motor shaft. In this way, the coupled torque control 
approach can be used without requiring that control systems 1 and 2 have any 
electrical connections that violate the integrity of the redundant channels. 

VII. CONCLUSIONS AND RECOMMENDATIONS 

In this report, the following related aspects of the ARID project have 
been discussed 1) Modeling of the ARID, 2) Design of control algorithms for 
the ARID, and 3) Nonlinear- based simulation of ARID control algorithms. 
Based on the information delineated in this report, conclusions and 
recommendations are now made to assist KSC personnel in the successful 
completion of the ARID project 


7.1 Conclusions 

To aid KSC personnel in the successful completion of the ARID project, a 
study was done to examine the associated modeling and control aspects of the 
ARID robot. With regard to modeling, the rigid body statics and dynamics 
were formulated to describe the geometry and dynamic motion of the ARID. A 
model including the effects of joint flexibilities and dominant vibrations 
were then incorporated into the rigid- body dynamics. Since the ARID utilizes 
a redundant actuation system, a model including redundant actuation was 
formulated. 

With regard to control, a robust saturation controller was shown to 
outperform a PD controller for the rigid body dynamics. For the inclusion of 
joint flexibilities and dominant vibrational effects into the rigid body 
dynamics, a nested PD motor/link controller and a nested PD motor/link/tip 
controller were both shown to outperform a PD motor controller. To 
investigate the effects of redundant actuation on the control system 
performance, an independent nested PD motor/link torque controller and a 
coupled nested PD motor/link torque controller were both shown to give good 
performance inspite of a single motor failure. 

7 . 2 Recosunendat ions 

Since it is widely recognized by robotic engineers that the robot control 
problem must be solved at the torque input level, it is suggested that the 
motor drive units be changed to accommodate torque based control development. 
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It is important to note that the synchronization of the redundant motors 
appears not to be a potential problem if a proper torque based control is 
used. 

To compensate for joint flexibilities induced by the harmonic drives, it 
is suggested that redundant "base- mounted" link encoders be added to the 
design. Simply stated, if you do not measure link position, you can not 
control link position. 

If link flexibilities (i.e. vibrations) are noted to be a problem during 
the initial testing phase, it is suggested that redundant link tip 
measurement devices (such as accelerometers) be added to the design. 

Determine the failure mode of each motor to see if it continues to turn 
if it stops running due to a failure. 

Since the host computer for the ARID control system is a relatively slow 
computer, it is suggested that a high speed DSP expansion board be added to 
the design to speed up online transmission and collection of data. 

To reduce the time spent writing code and doing hardware interfacing, it 
is suggesting that a high level software system (for example LABVIEW) be 
used. Moving the robot accurately is a hard enough task as it is; therefore, 
re-design of low-level software and hardware should be avoided. It should 
also be noted that National Instruments sells a high-speed DSP expansion 
board' (i.e. NB-DSP2300, 32-bit, 33 MFLOPS, high speed data transfer) for 
LABVIEV applications. 

Utilize Jacobian matrix in conjunction with task- space formulation to 
avoid solving the inverse- kinematics online. 

Since large movements of the prismatic joint may cause excessive 
vibration, KSC personnel should plan to make large movements with the 
revolute joints as a backup mode of operation. 

Since exact position of the radiator is not known, it suggested that the 
controller incorporate feedback (i.e. range sensors) to accurately place the 
ARID end- effector. If the radiator panel does warp, it is believed that no 
"warping model" will model these nonlinear effects accurately enough to move 
the camera at 24" + 1/8" tolerance in an open loop configuration. 

Since it would be desirable for computer system 1 to know the position 
and velocity of motor 2, it is suggested that redundant motor encoders be 
added to the the design (This concept maintains the validity of the redundant 
specification) . Note that redundant motor encoders will be needed if the 
ARID robot requires a coupled control approach. 

If the ARID can not be accurately moved with simple nested PD control 
laws as the ones given in this report, KSC personnel should use advanced 
control techniques such as the ones given in [5] and [6] . 
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To make the programs written in this report more useful, the following 
steps should be taken: 1) the prismatic program should be combined with the 
revolute program, 2) the redundant motor model should then be included, and 
3) actual task space desired trajectories related to the radiator surface 
should then be included. If all these steps are taken, one program can then 
be used to evaluate the overall system performance. 

If the PC23 indexer is used and a torque based controller is not used 
then vibration can be reduced by using the S- curve velocity profiling 
algorithm that comes with the indexer. 
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